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Abstract 



The system has a first optimal filter for calibrating an autonomous speed sensor arrangement, which 
receives only a speed vector determined autonomously in a reference coordinate system and an 
independently determined speed vector. A second optimal filter for course angle support and calibration of 
the autonomous course angle receives only a corrected course angle and a course angle derived by the 
independently determined speed vector. The optimal filters provide corrections for error models. 
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Die folgenden Angaben sind den vom Anmelder eingereichten Unterlagen entnommen 

@ Koppelnavigationssystem 

@ Ein Koppelnavigationssystem enthalt einen bordauto- ]Q 

nomen Geschwindigke its- Sensor (10), einen bordautono- / 

men Kurs-Sensor (12) und einen Koppelrechner (32) zur | ' \ 

Positions- und Geschwindigkeitsbestimmung in einem T " 

Referenzkoordinatensystem aus den Meftwerten der Ge- * [ \k 

schwindigkeits- und Kurs-Sensormittel (10; 12). Ge- 
schwindigkeits- und Kurs Skaiierungs- und Fehlerkorrek- 
turmittel (14 bzw. 16) dienen zur Skalierung und Fehler- 
korrektur der auf den Koppelrechner (32) aufzuschalten- 

den Me&werte des bordautonomen Geschwindigkeits- 20" 
Sensors (10) bzw. eines bordautonomen Kurs-Sensors 
(12) anhand von Fehlermodellen mit Parametern. Ein un- 18' 
abhangiger Geschwindigkeits-Sensor (36), z. B. ein GPS- 
Empfanger, liefert unabhangig von den bordautonomen 
Geschwindigkeits-Sensoren (10, 12) einen Geschwindig- 
keitsvektor des Fahrzeugs. Optimalfiltermittel weisen ein 
erstes Optimalfilter (50) zur Kalibrierung des bordautono- 
men Geschwindigkeits-Sensors (10) und ein davon unab- 62" 
■ hangiges zweites Optimalfilter (52) zur Kurzwinkelstut- 

zung und Kalibrierung des bordautonomen Kurs-Sensors K*56 
(12) auf. Die Optimalfilter bringen Korrekturen an den Pa- 
rametern der Fehlermodelle der Skaiierungs- und Fehler- U 54 
korrekturmittel (14, 16) an. Durch die dezentralisierte Ar- \/ 
chitektur der Optimalfilter wird das Koppelnavigationssy- / 
stem robuster. Es werden Rechenaufwand und Speicher- 50 
bedarf reduziert. 
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Beschreibung 



Die Erfindung betrifft ein Koppelnavigatiohssystem nach 
dem Oberbegriff des Patentanspruchs 1 . 

Bei der Koppelnavigation wird die Position eines Fahr- 
zeugs relativ zu einem Ausgangspunkt aus Kurs und Ge- 
schwindigkeit bestirnmt. Der momentane Kurswinkel ge- 
stattet es, die momentane Geschwindigkeit in Kbmponenten 
zu zerlegen. Die zeitliche Integration der Komponenten lie- 
fert die Position in zwei Koordinaten. Kurs und Geschwin- 
digkeit werden dabei durch bordautonome Sensoren be- 
stimmt. Das sind Geschwindigkeitsmesser verschiedener 
Art und z. B. Kurskreisel oder inertiale Kursreferenzsy- 
steme. Die Geschwindigkeits- und Kurssensoren sind mit 
systematischen Fehlern wie Skalenfaktorfehlern, Null- 
punktfehlern und Drift behaftet. Das fuhrt zu einem sich 
aufintegrierenden Fehler der aus der Koppelnavigation ge- 
wonnenen Position. 

Es sind Satelbten-Navigationssysteme (GPS) bekannt, 
die mit hoher Genauigkeit Position und Geschwindigkeit ei- 
nes Fahrzeugs in einem Referenzkoordinatensystem (Lange 
und Breite) liefern. Die Signale des Satelliten-Navigations- 
systems konnen jedoch nicht immer empfangen werden 
oder konnen gestort werden. 

Es ist daher bekannt, ein mit bordautonomen Sensoren ar- 
beitendes Koppelnavigationssystem durch ein Satelliten- 
Navigationssystem (oder ein anderes Navigationssystem, 
wie Funkpeilung, das eine Bestimmung der Position des 
Fahrzeugs "von auBen" gestattet) zu stiitzen. 

Bei einem bekannten Koppelnavigationssystem sind 
bordautonome Geschwindigkeits-Sensormittel; z. B. ein 
Log oder ein Tachometer, und bordautonome Kurs-Sensor- 
mittel, z. B. ein Kurskreisel, vorgesehen. Geschwindigkeits- 
Skalierungs- und Fehlerkorrekturmittel dienen zur Skalie- 
rung und Fehlerkorrektur der MeBwerte der bordautonomen 
Geschwindigkeits-Sensormittel anhand eines Geschwindig- 
keits-Fehlermodells mit ersten Parametern. Kurs-Skalie- 
rungs- und Fehlerkorrekturmittel dienen zur Skalierung und 
Fehlerkorrektur der bordautonomen Kurs-Sensormittel an- 
hand eines Kurs-Fehlermodells mit zweiten Parametern. 
Aus den skalierten und fehlerkorrigierten MeBwerten der 
Geschwindigkeits- und Kurs-Sensormittel erfolgt eine Posi- 
tions- und Geschwindigkeitsbestimmung in einem Refe- 
renzkoordinatensystem. Weiterhin sind unabharigige Ge- 
schwindigkeits-Sensormittel, etwa in Form eines Ernpfan- 
gers fur die Satelli ten-Navigation, vorgesehen, die unabhan- 
gig von den bordautonomen Geschwindigkeits-Sensormit- 
teln einen Geschwindigkeitsvektor des Fahrzeugs liefern. 
Eine Stutzung der Geschwindigkeits- und Positionsbestim- 
mung erfolgt durch Optimatnltermittel, auf welche die so 
bestimmte Geschwindigkeit und der skalierte und fehler- 
korngierte Kurswinkel aufgeschaltet sind und auf welche 
weiterhin der Geschwindigkeitsvektor von den unabhangi- 
gen Geschwindigkeits-Sensormiiteln aufgeschaltet ist. 
Durch die Optimalfilterrnittel sind Korrekturen an den er- 
sten und zweiten Parametern der Geschwindigkeits-Skalie- 
rungs- und Fehlerkorrekturmittel bzw. der Kurs-Skalie- 
rungs. Und Fehlerkorrektunnittel anbringbar. 

Nach dem Stand der Technik enthalten die Optimalfilter- 
rnittel ein vollstandiges lineares Fehlermodell, das sowohl 
die bordautonomen Geschwindigkeits-Sensormittel als auch 
die bordautonomen Kurs-Sensormittel und ihre Verkniip- 
fungen wiedergibt. Auf dieses einheiiliche Optimal filter 
werden sowohl die Geschwindigkeit, der Kurs und die Posi- 
tion aufgeschaltet, wie sie sich skaliert und fehlerkorrigiert 
aus der Koppelnavigation ergeben, als auch der Geschwin- 
digkeitsvektor, der unabhangig von den bordautonomen 
Sensorniitleln "von auRcn" von den unabhangigen Ge- 



schwindigkeits-Sensormitteln, z. B; einem GPS-Empfanger, 
geliefert werden. Danach erfolgt die Skalierung und Korrek- 
tur der "ersten" und "zweiten" Parameter. 

Dieses bekannte einzige, "zentralisierte" Optimalfilter 

5 weist einige schwerwiegende Nachteile auf: Wegen des li- 
nearen Fehlermodells rnussen die Differenzen zwischen den 
Ergebnissen der bordautonomen Koppelnavigation und de- 
nen der unabhangigen Positions- und Geschwindigkeitssen- 
sormittel innerhalb des linearen Parameterraumes liegen. 

10 Das bekannte Optimalfilter erfordert einen hohen Rechen- 
aufwand und Speicherplatzbedarf . Das "zentralisierte" Opti- 
malfilter erfordert weiter einen hohen Aufwand fur die Ent- 
wicklung, Analyse und Priifung. 

Die DE 29 22 415 C2 beschreibt ein Navigationsgerat fur 

15 Landfahrzeuge, das mit einem Tragheitsnavigationssystem, 
einem - auch bordautonomen - nicht-inertialen Geschwin- 
digkeitssensor und einem Kalmanfilter aufgebaut ist. Das 
Tragheitsnavigationssystem enthalt drehempfindliche Trag- 
heitssensoren und Beschleunigungsmesser. Das Kalmanfil- 

20 ter als "Optimalfilter" enthalt ein Fehlermodell mit alien 
Verkniipfungen der Lagewinkel und Beschleunigungen. Als 
"Residuum" erhalt das Kalmanfilter Differenzen der von 
dem Tragheitsnavigationssystem gelieferten inertialen Ge- 
schwindigkeiten und der von dem nicht-inertialen Ge- 

25 schwindigkeitssensor erhaltenen Geschwindigkeits-Me6- 
werte. Das Kalmanfilter liefert Schatzwerte fur die Ge- 
schwindigkeits- und Winkelfehler des Tragheitsnavigations- 
systems. Um diese Fehler werden die inertial- erhaltenen 
Werte korrigiert. 

30 Hier werden zwei bordautonome MeBwerte, namlich die 
inertiale Geschwindigkeit und die von einem am Fahrzeug 
vorgesehenen Geschwindigkeitsmesser erhaltene Ge- 
schwindigkeit, miteinander verglichen. Ein einziges Opti- 
malfilter verkniipft Geschwindigkeiten und Lagewinkel. 

35 Die US 37 02 447 A beschreibt ein Navigationsgerat, bei 
welchem GeschwindigkeitsmeB werte einmal von einem 
Tragheitsnavigationssystem und zum anderen von einem 
nicht-inertialen Geschwindigkeitsmesser geliefert werden. 
Die Differenzen der auf die verschiedenen Weisen gewon- 

40 nenen GeschwindigkeitsmeBwerte sind auf ein Kalmanfilter 
geschaltet. Das Tragheitsnavigationssystem liefert weiter 
eine pradizierte Dopplerverschiebung fur die Signale eines 
Satelli ten-Navigationssystems. 

Diese. pradizierte Dopplerverschiebung wird mit der 

45 Dopplerverschiebung der von einem Satelliten-Navigations- 
system tatsachlich empfangenen Signale verglichen. Auch 
diese Differenz wird auf das einzige, zentrale Kalmanfilter 
geschaltet. 

Ein Aufsatz von Satz, Cox jr., Beard und Landis "GPS 
50 Inertial Attitude Estimation via Carrier Accumulated-Phase 
Measurements" in "Navigation: Journal of the Institute of 
Navigation", Bd. 38 (1991), 273-284 beschreibt die Stut- 
zung eines inertialen Kurs-Lage-Referenzgerates durch Na- 
vigationssatelliten mittels eiries Kalmanfilters. Eine ahnli- 
55 che Anordnung beschreibt die DE 196 51 543 CI. 

Der Erfindung liegt die Aufgabe zugrunde, den Rechen- 
aufwand und den Speicherbedarf der OptimalfiUennittel ge- 
geniiber der Losung nach dem Stand der Technik zu vermin- 
dern. 

60 Der Erfindung liegt weiter die Aufgabe zugrunde, die 
mog lichen Wertebereiche fiir die zu schatzenden Parameter 
der Fehlemiodelle der bordautonomen Sensoren zu erwei- 
tern. 

Der Erfindung liegt schlieRlich die Aufgabe zugrunde, ein 
65 gesLutzl.es Koppelnavigationssystem im Vcrgleich zum 
Stand der Technik robuster gegen Systemslorungen und Pa- 
ranteterandcrungen zu rnachen. 

ErfindungsgemaB wird dies durch die im Kennzeichen 
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des Patentanspruchs 1 aufgefuhrten Merkmale gelost. 

Durch die Aufteilung der "zentralen" Optimalfiltermittel 
in mehrere einzelne Optimalfilter, auf die bordautonome 
und unabhangig bestinunte MeBwerte jeweils einer MeB- 
groBe (Geschwindigkeit oder Kurs) aufgeschaltet sind und 
von denen eines nur die Parameter des Fehlermodells fur die 
bordautonome Geschwindigkeitsmessung und das andere 
nur die Parameter des Fehlermodells fur die bordautonome 
Kursmessung bestimmt, konnen der Rechenaufwand und 
der Speicherplatzbedarf erheblich verringert werden. Das 
Koppelnavigationssystem wind robuster. Bei dieser Anord- 
nung werden zwar die Verkniipfungen der MeBgroBen bei 
der Architektur der Optimalfiltermittel aufier acht gelassen. 
Es hat sichj aber gezeigt, daB die dadurch gegeniiber der 
"zentralisierten Architektur" verursachten Fehler vemach- 
lassigbar sirid. 

Ausgestaltungen der Erfindung sind Gegenstand der Un- 
teranspruche. . 

" Die Erfindung istriachstehend an eineni Ausfuhrungsbei- 
spiel untef. Bezugnahme auf die zugehorigen Zeichnungen 
naher erlautert. 

Fig. 1 ist ein Blockdiagramm und zeigt ein Koppelnavi- 
gauonssystem nach dem Stand der Technik mit einem einzi- 
gen, "zentralen" Optimalfilter. • 

Fig. 2 ist ein Blockdiagramm ahnlich Fig. 1 und zeigt ein 
Koppelnavigauonssystem mit mehreren "dezentralisierten" 
Optimalfiltern. 

Fig. 3 ist ein Blockdiagramm und zeigt das kalibrierte 
Koppelnavigauonssystem. 

In Fig. 1 sind mit 10 bordautonome Geschwindigkeits- 
Sensormittel bezeichnet. Dabei kann es sich um Radsenso- 
ren oder Odometer handeln, die bei einem Landfahrzeug ein 
zur momentanen Fahrzeuggeschwindigkeit proportionales 
Signal liefern. Es kann sich um zwei Beschleunigungsmes- 
ser handeln, die mit ihren MeBachsen in Richtung der Fahr- 
zeuglangsachse bzw. der Fahrzeugquerachse fahrzeugfest 
montiert sind, wobei die Beschleunigungssignale zeitlich in- 
tegriert werden. Es kann sich um ein-, zwei- oder dreiach- 
sige Geschwindigkeitssensoren handeln, die nach dem 
Dopplerprinzip arbeiten. SchlieBlich kann es sich auch um 
ein-, zwei- oder dreiachsige Geschwindigkeitssensoren han- 
deln, welche die Fahrzeuggeschwindigkeit relativ zu der 
Luftstromung ("True Airspeed Sensor") oder relativ zur 
Wasserstromung (Log) messen. 

Mit 12 sind Kurs-Sensormlttel bezeichnet. Das kann bei 
einer Anordnung mit zwei Beschleunigungsmessern ein 
fahrzeugfest montierter Kreisel sein, dessen Eingangsachse 
nicht in der von den MeBachsen der Beschleunigungsmesser 
aufgespannten Ebene liegt. Es kann sich auch um eine An- 
ordnung mit drei zueinander orthogonalen Kreiseln handeln, 
die entweder fahrzeugfest (Strapdown-System) oder auf ei- 
ner raumfest stabilisierten Plattform (Plattfonn- System) 
montiert sind. Es kann sich um einen pendelnd aufgehang- 
ten Kurskreisel handeln, dessen MeBachse mit der lokalen 
Lotachse zusammenfallt und der Vorrichtungen zur Bestim- 
mung der Lagewinkel aufweist. Es kann auch ein fahrzeug- 
fest montierter Kreisel vorgesehen sein, dessen Eingangs- 
achse mil der Hochachse des Fahrzeugs zusammenfallt, 
wenn z. B. bei einem Wasserfahrzeug die im Mittel wahrend 
der Mission auftretenden Lagewinkel bekannt sind. In den 
meisten Fallen liefem die inertialen Kurs-Sensormittel 14 
Winkelgeschwindigkeiten, also Kursanderungen. 

Die von den Geschwindigkeits-Sensormitleln 10 und den 
Kurs-Sensormilteln 12 erhahenen MeBwerte sind mit syste- 
matischen Fehlern wie Nullpunkffehlern, Skalenfaktorfeh- 
lern oder Drift behaftet. Diese Fehler konnen durch ein Feh- 
lenuodeli mit Paramciern dargcsiellt werden. Ein Fehlermo- 
dell der Gcschwindigkciis-Sensonuiuel 10 cnlhalt "ersle" 
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Parameter. Ein Fehlermodell der Kurs-Sensormittel 12 ent- 
halt "zweite" Parameter. Wenn fur die Fehler bzw. die Para- 
meter des Fehlermodells in noch zu beschreibender Weise 
eine optimale Schatzung vorliegt, kann eine entsprechende 

5 Skalierung und Fehlerkorrektur an den MeBwerten der Ge- 
schwindigkeits- und Kurs-Sensormittel 10 bzw. 12 vorge- 
nommen werden. Das ist in Fig, 1 fur die Geschwindigkeits- 
Sensormittel 10 durch Geschwindigkeits-Skalierungs- und 
Fehlerkorrekturmittel 14 und fur die Kurs-Sensormittel 12 

10 durch Kurs- Skalierungs- und FehlerkorTekturrnittel 16 dar- 
gestellt. 

Die Geschwindigkeits-Skalierungs- und Fehlerkorrektur- 
mittel 14 liefem einen an hand des Fehlermodells mit den er- 
sten Parametern skalierten und fehlerkorrigierten Ge- 

15 schwindigkeitsvektor in einem Fahrzeugfesten Koordina- 
tensystem, wie durch einen "Ausgang" 18 dargestellt ist. Die 
Kurs-Skalierungs- und Fehlerkorrekturmittel liefem einen 
anhand des Fehlermodells mit den zweiten Parametern ska- 
lierten und fehlerkorrigierten MeBwert fur den Kurswinkel 

20 bzw. die Kurswinkelanderung. Auf die Kurs-Skalierungs- 
und Fehlerkorrekturmittel 16 ist vom Ausgang 18 der Ge- 
schwindigkeits-Skalierungs- und Fehlerkorrekturmittel 14 
noch der Geschwindigkeitsvektor aufgeschaltet, wie durch 
die Verbindung 20 dargestellt ist. Weiterhin erhalten die 

25 Kurs-Skalierungs- und Fehlerkorrekturmittel noch die Posi- 
tion und den Kurswinkel, die in noch zu beschreibender 
Weise erhalten werden. Das ist durch einen Pfeil 22 darge- 
stellt. 

Die Kurs-Skalierungs- und Fehlericoirekturrnittel liefem 

30 Lagewinkel an einem "Ausgang" 24 sowie die Kurswinkel- 
anderung an einem "Ausgang" 26. Die Kurswinkelanderung 
wird durch einen Integrator 28 integriert und liefert den 
Kurswinkel am "Ausgang" 30 des Integrators 28. Der Ge- 
schwindigkeitsvektor vom Ausgang 18, die Lagewinkel 

35 vom Ausgang 24 und der Kurswinkel vom Ausgang 30 bil- 
den die EingangsgroBeri der Koppelrechnung, die durch ei- , 
nen Block 32 dargestellt sind. Die Koppelrechnung gemaB 
Block 32 liefert an einem "Ausgang" 34 die Position, den 
Geschwindigkeitsvektor in einem erdfesten Referenzkoor- 

40 dinatensystem sowie Kurs- und Lagewinkel. 

Das ist der ubliche Aufbau eines Koppeinavigationssy- 
stems. Das Koppelnavigationssystem kann durch Positions- 
und Geschwindigkeitssensormittel 36 gestiiptzt werden. Die 
von den bordautonomen Geschwindigkeits-Sensormitteln 

45 unabhangig sind und die Position und Geschwindigkeit des 
Fahrzeugs "von auBen" bestimmen. Diese Positions- und 
Geschwindigkeitssensormittel 36 konnen beispiels weise 
vom Empfanger eines S ate lliten-Navigationssy stems wie 
GPS gebildet sein. Die Position und Geschwindigkeit kann 

50 aber auch Z; B. durch Funkpeilung bestimmt werden. Die 
Positions- und Geschwindigkeitssensormittel 36 liefem an 
einem "Ausgang" 40 die Position des Fahrzeugs und den 
Geschwindigkeitsvektor in einem erdfesten Referenzkoor- 
dinatensystem. 

55 Bei der in Fig. 1 dargestellten Ausfuhrung nach dem 
Stand der Technik ist ein einziges, zentrales Optimalfilter 
42, beispielsweise ein KalmanfUter, zur Systernstiitzung und 
Kalibrierung vorgesehen. Das zentrale Optimalfilter 42 
stellt ein vollstandiges Modell des Kursreferenzsy stems mit 

60 alien Verkniipfungen der verschiedenen MeBgroBen dar. 
Das Optimalfilter 42 erhalt von der Koppelrechnung gemaB 
Block 32 die Position, den Geschwindigkeitsvektor irn Re- 
ferenzkoordinalensystem sowie die Kurs- und Lagewinkel 
des Fahrzeugs, so wie diese von der Koppelrechnung 32 be- 

65 rechnet werden. Das Optimalfilter 42 erhalt weiter die "von 
auRen" bestimnite Position und den Geschwindigkeitsvektor 
von den unabhangigen Positions- und Gcschwindigkeitssen- 
sonniilcln. Die Parameter des Modells in dem Optimalhlicr 
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42 werden variiert, bis das Modell optimal mit der Realitat 
ubereinstimmt. Als Kriterium hierfur dienen die Abwei- 
chungen der durch die Koppelrechnung gewonnenen Ge- 
schwindigkeit von der durch die unabhangigen Positions- 
und Geschwindigkeitssensormittel 36 gewonnenen Ge- 5 
schwindigkeit und der durch die Koppelrechnung gewonne- 
nen Position von der durch die unabhangigen Positions- und 
Geschwindigkeitssensormittel 36 gewonnenen Position. 
Das ist ahnlich wie bei der oben schon erwahnten 
US 3 702 477 A. Das Optimalfilter 42 liefert auch Korrektu- 10 
ren fur die ersten und zweiten Parameter der Fehlermodelle 
der.Geschwihdigkeits- bzw. Kurs-Skalierungs- und Fehler- 
korrekturmittel 14 bzw. 16. Diese Korrekturen sind in Fig. 1 
durch Verbindungen 44 bzw. 46 dargestellt. 

Das zentrale Optimalfilter 42 liefert auch eine Positions- 15 
korrektur fur die Koppelrechnung 32, was in Fig. 1 durch 
eine Verbindung 48 dargestellt ist. 

Das die Erfindung verwirklichende, gestutzte Koppelna- 
vigationssystem von Fig. 2 mit "dezentralisierter Architek- 
tur" ist in vielen Punkten ahnlich aufgebaut wie das be- 20 
kannte Koppelnavigationssystem von Fig. 1. Entsprechende 
Teile sind in beiden Figuren mit den gleichen Bezugszei- 
chen versehen und wirken in gleicher Weise. 

Bei der errindungsgemaBen Ausfuhrung nach Fig. 2 sind 
statt des einen "zentralen" Optimalfilters 42 von Fig. 1 drei 25 
Optimalfilter 50, 52 und 54 vorgesehen. 

Das Optimalfilter 50 enthalt nur ein Modell der bordauto- 
nomen Geschwindigkeits-Sensonrrittel 10 ohne Beriicksich- 
tigung der Verkniipfung der gemessenen Geschwindigkeit 
mit den anderen MeBgroBen Lagewinkel, Kurswinkel und 30 
Position. Auch hier werden Parameter des Modells variiert, 
bis der von der Koppelrechnung gelieferte Geschwindig- 
keitsvektor mit dem von den unabhangigen Positions- und 
Geschwindigkeitssensormitteln 36 gelieferten Geschwin- 
digkeitsvektor ubereinstimmen. Zu diesem Zweck ist der 35 
durch die Koppelrechnung in dem Referenzkoordinatensy- 
stem erhaltene Geschwindigkeitsvektor iiber eine Verbin- 
dung 56 auf das Optimalfilter 50 urid nur auf dieses Opti- 
malfilter 50 aufgeschaltet. Von den unabhangigen Positions- 
und Geschwindigkeitssensormitteln erhalt das Optimalfilter 40 
50 - und wieder nur dieses Optimalfilter 50 - den "unabgan- 
gig" gemessenen Geschwindigkeitsvektor iiber eine Verbin- 
dung 58. Das Optimalfilter 50 liefert Korrekturen nur fiir die 
"ersten" Parameter des Fehlermodells der Geschwindig- 
keits-Skalierungs- und Fehlerkorrekturmittel 14, nicht fur 45 
die zweiten Parameter der Kurs-Skalierungs- und Fehlerkor- 
rekturmittel 16, iiber eine Verbindung 60. 

In ahnlicher Weise enthalt das Optimalfilter 52 nur ein 
Modell der bordautonomen Kurs-Sensorrnittel 12 ohne Be- 
riicksichtigung der Verkniipfung des gemessenen Kurswin- 50 
kels mit den anderen MeBgroBen Geschwindigkeit und Posi- 
tion. Auch hier werden Parameter des Modells variiert, bis 
der von der Koppelrechnung gelieferte Kurswinkel mit dem 
von den unabhangigen Positions- und Geschwindigkeitssen- 
sormitteln 36 gelieferten Kurswinkel ubereinstimmen. Zu 55 
diesem Zweck ist der von dem Integrator 28 erhaltene Kurs- 
winkel iiber eine Verbindung 62 auf das Optimalfilter 52 und 
nur auf dieses Optimalfilter 52 aufgeschaltet. Von den unab- 
hangigen Positions- und Geschwindigkeitssensormitteln 36 
erhalt das Optimalfilter 52 - und wieder nur dieses Optimal- (*) 
filter 52 - den "unabgangig" gemessenen Kurswinkel Liber 
eine Verbindung 64. Das Optimalfilter 52 liefert Korrektu- 
ren nur fur die "zweiten" Parameter des Fehlermodells der 
Kurs-Skalierungs- und Fehlerkorrekturmittel 16 ; nicht fiir 
die ersten Parameter der Geschwindigkeits-Skalierungs- r »5 
und Fehlerkorrekturmittel 14 iiber eine Verbindung. 

Das drilt.e Optimal lilter 54 dient nur zur Positionsstiii- 
/.ung. Das Optimal filter 54 erhalt von der Koppelrechnung 
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32 die durch diese ermittelte Position in dem Referenzkoor- 
dinatensystem. Das ist durch die Verbindung 68 dargestellt. 
Weiterhin erhalt das Optimalfilter 54 die Position, die von 
den unabhangigen Positions- und Geschwindigkeitssensor- 
mitteln geliefert wird, iiber eine Verbindung 70, Das Opti- 
malfilter 54 liefert eine Positionskorrektur fiir die Koppel- 
rechnung 32, wie durch eine Verbindung 72 dargestellt ist. 

Fig* 3 zeigt das Koppelnavigationssystem nach Skalie- 
rung und Fehlerkorrektur Die Parameter der Skalierungs- 
und Fehlerkorrekturmittel sind dann so eingestellt, daB sie 
den genauen Geschwindigkeitsvektor im fahrzeugfesten 
Koordinatensystem bzw. die genaue Kurswinkelanderung 
liefern. Die so eingestellten Geschwindigkeits-Skalierungs- 
und Fehlerkorrekturrnittel und die so eingestellten Kurs- 
Skalierungs- und Fehlerkorrekturmittel sind in Fig. 3 mit 
14A bzw. 16A bezeichnet. Der Integrator 28 liefert den ge- 
nauen Kurswinkel. Aus diesen genauen MeBwerten ergibt 
sich durch die Koppelrechnung 32 die genaue Position und 
die genaue Geschwindigkeit im erdfesten Referenzkoordi- 
natensystem. 

Patentanspriiche 

1 . Koppelnavigationssystem, enthaltend 

(a) bordautonome Geschwindigkeits-Sensormit- 
tel (10) 

(b) bordautonome Kurs-Sensorrnittel (12) 

(c) Geschwindigkeits-Skalierungs- und Fehler- 
korrekturmittel (14) zur Skalierung und Fehler- 
korrektur der MeBwerte der bordautonomen Ge- 
schwindigkeits-Sensormittel (10) anhand eines 
Geschwindigkeits-Fehlermodells mit ersten Para- 
metern, 

(d) Kurs-Skalierungs- und Fehlerkorrekturmittel 
(16) zur Skalierung und Fehlerkorrektur der bord- 
autonomen Kurs-Sensorrnittel (12) anhand eines 
Kurs-Fehlermodells mit zweiten Parametern, 

(e) Mittel (32) zur Positions- und Geschwindig- 
keitsbestimmung in einem Referenzkoordinaten- 
system aus den skalierten und fehlerkorrigierten 
MeBwerten der Geschwindigkeits- und Kurs-Sen- 
sorrnittel (10; 12), . 

(f) unabhangige Geschwindigkeits-Sensormittel 
(36), die unabhangig von den bordautonomen Ge- 
schwindigkeits-Sensormitteln (10,12) einen Ge- 
schwindigkeitsvektor des Fahrzeugs liefert, und 

(g) Opumalfilterrnittel 

- auf welche die so bestimmte Geschwin- 
digkeit und der skalierte und fehlerkorri- 
gierte Kurswinkel aufgeschaltet sind, 

- auf welche weiterhin der Geschwindig- 
keitsvektor von den unabhangigen Ge- 
schwindigkeits-Sensormuteln aufgeschaltet 
ist und 

- durch welche Korrekturen an den ersten 
und zweiten Parametern der Geschwindig- 
keits-Skalierungs-. und Fehlerkorrekturmittel 
(14) bzw. der Kurs-Skalierungs- und Fehler- 
korrekturmittel (16) anbringbar sind, 

dadurch gekennzeichnet, daB 

(h) die Optimalfiltermittel ein erstes Optimalfilter 
(50) zur Kalibrierung der bordautonomen Ge- 
schwindigkeits-Sensormittel (10) aufweisen, 
auf welches nur 

der bordautonom bestimmte Geschwindigkeits- 
vektor in dem Referen/koordinaiensystem von 
den Mitteln (32) zur Positions- und Geschwindig- 
keitsbestimmung und 
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der unabhangig bestimmte Geschwindigkeitsvek- 
tor von den unabhangigen Geschwindigkeits-S en- 
sormitteln (36) 

aufgeschaltet sind, und durch welches 
Korrekturen an den ersten Parametern des Ge- 5 
schwindigkeits-Fehlermodells auf die Geschwin- 
digkeits-S kalierungs- und Fehlerkorrekturrnittel 
(14) aufschaltbar sind, und 

(i) die Optimalfiltermittel ein zweites Optimalfil- 
ter (52) zur Kurswinkelstiitzung und Kalibrierung io 
der bordautonomen Kurs-Sensormittel (12) auf- 
weisen, 

auf welches nur 

der skalierte und fehlerkomgierte Kurswinkel und 
ein aus dem unabhangig bestimmten Geschwin- 15 
digkeitsvektor von den unabhangigen Geschwin- 
digkeits-S ensormitteln (36) abgeleiteter Kurswin- 
kel 

aufgeschaltet sind, und durch welches 
Korrekturen an den zweiten Parametern des Kurs- 20 
Fehlermodells auf die Kurs-Skalierungs- und Feh- 
lerkorrekturmittel (16) aufschaltbar sind. 

2. Koppelnavigationssystem nach Anspruch 1, da- 
durch gekennzeichnet, daB 

(a) die unabhangigen Geschwindigkeits-S ensor- 25 
mittel (36) Positions- und Geschwindigkeitssen- 
sormittel sind, von denen eine unabhangig be- 
stimmte Positionsinformation abgreifbar ist, und 

(b) die OptimalfUtermittel zusatzlich ein drittes 
Optimalfilter (54) zur Positionsstutzung enthalten, 30 
auf welches nur 

die Position von den Mitteln (32) zur Positions- 
und Geschwindigkeitsbestimmung und 
die unabhangig bestimmte Position von den unab- 
hangigen Positions- und Geschwindigkeitssensor- 35 
mitteln (36) 

aufschaltbar sind, und durch welches 
eine Positionskorrektur an den Mitteln (32) zur 
Positions- und Geschwindigkeitsbestimmung 
anbringbar ist. 4p 

3. Koppelnavigationssystem nach Anspruch 1 oder 2, 
dadurch gekennzeichnet, daB die unabhangigen Ge- 
schwindigkeitssensormittel (36) von einem Empfanger 
eines Satelliten-Navigationssystems gebildet sind. 
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